#include <arduino/Arduino.h>

#include <servo/sg90.h>


int main(void)
{
  init();

#if defined(USBCON)
  USBDevice.attach();
#endif

  pinMode(13, OUTPUT);
  digitalWrite(13, LOW);

  servo::sg90 serv(10);

  while (true)
  {
    digitalWrite(13, HIGH);
    for(int i = 0; i < 180; ++i)
    {
      serv.set_position(i);
      delay(20);
    }

    digitalWrite(13, LOW);
    for (int i = 180; i > 0; --i)
    {
      serv.set_position(i);
      delay(20);
    }

    delay(1000);

    if (serialEventRun) serialEventRun();
  }

  return 0;
}
